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[ SECTION  1 

i 

■ SCOPE 


1 . 1  IDENTIFICATION 

Volume  I,  Submarine  OMEGA  Computer  Program  Performance  Specification,  defines 
the  functional  requirements  for  the  Submarine  OMEGA  Computer  Program  which 
is  used  by  the  AN/ARN-99  OMEGA  Navigation  Set.  The  Navigation  set  and  the 
OMEGA  program  together  comprise  the  Submarine  OMEGA  Navigation  System.  The 
tape  which  defines  the  computer  program  is  entitled  AN/BRN-7  Navigation 
Program, 

Volume  II,  Submarine  OMEGA  Computer  Program  Design  Specification,  allocates 
the  functional  requirements  of  Volume  I to  the  computer  routine  and  sub- 
program level. 

This  volume  describes  the  subprogram  designated  as  Navigation,  which  has  two 
abbreviations  in  the  program  listing  (Volume  XIII)  due  to  the  fact  that 
NAVIGATION  is  composed  of  two  routines:  the  Velocity  Processing  Routine 
with  the  abbreviation  VP;  and  the  RIJ  Update  Routine  with  the  abbreviation 
RU. 


1.2  SUBPROGRAM  TASKS 


1.2.1  Velocity  Processing  (See  Figure  1) 

a)  The  incoming  Velocity  and  Heading  data  must  be  read  from  the  analog-to- 

digital  synchro  inputs,  then  smoothed  if  necessary.  ' 

b)  The  Velocity/Heading  mode  marker  must  be  checked  to  determine  whether 
the  synchro  or  manual  inputs  will  be  used. 

c)  Uncorrected  velocity  is  then  resolved  to  the  R^  and  R^  reference  axes. 

d)  Velocity  is  corrected,  using  corrections  from  the  Combinational  Filter.  ^ 

1.2.2  RIJ  Update 

a)  The  rotational  correction  terms  must  be  calculated. 

b)  The  correction  terms  are  then  used  to  rotate  the  RIJ  matrix.  h 


c)  The  Wander  Azimuth  Angle  is  computed  for  use  by  other  programs. 
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FIGURE  1 VELOCITY  PROCESSING 
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SECTION  2 

APPLICABLE  DOCUMENTS 


a)  Submarine  OMEGA  Computer  Program  Performance  Specifications,  Volume  I 
of  the  Submarine  OMEGA  Computer  Program  Specification. 

Applicable  Sections; 

3.1.1  Omega  Task  and  System  Breakdown 

3.3.13  Velocity  and  Heading  Processing 

3.3.14  Navigation 

b)  Submarine  OMEGA  Computer  Program  Design  Specification,  Volume  II  of 
the  Submarine  OMEGA.  Computer  Program  Specification. 

c)  NORT  68-66,  NAP70  User's  Manual,  July  1968. 

d)  NORT  68-115A,  Detailed  Description  of  NDC-1070  Computer  Instructions, 
Revision  A,  February  1970. 

e)  NORT  69-87A,  NDC-1070  Flow  Chart  Program,  User's  Manual. 
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SECTION  3 
REQUIREMENTS 


In  order  to  understand  the  program  description  contained  in  the  following 
pages,  it  is  necessary  that  the  reader  will  have  become  familiar  with  the 
associated  functional  requirements  found  in  Volume  I,  Performance  Specifi- 
cation, and  with  the  subprogram  allocation  found  in  Volume  II,  Design 
Specification . 


3.1  DETAILED  DESCRIPTION 


3.1.1  Reference  Labels  to  Flow  Diagrams 

The  code  used  to  reference  the  particular  block  in  the  flow  diagrams, 

Section  3.2,  is  as  follows:  The  first  number  is  the  page  number  found  in 
the  upper  right  corner  of  the  diagrams.  This  will  be  followed  by  a slash 
sign  (/)  to  separate  the  page  number  from  the  block  designator.  The  desig- 
nator will  either  be  a mnemonic  label  (e.g.,  TEST  SYNC),  a local  label 
indicated  by  a dollar  sign  ($) , or  an  integer.  The  two  types  of  labels 
reference  the  particular  information  block,  on  the  given  page,  to  which  the 
label  is  attached.  The  integer  number,  n,  means  that  the  referenced  block 

is  the  n^^  block  from  the  top  of  the  page;  P8/3  would  refer  to  page  8 and  the 
third  information  designation  down. 

Finally,  the  label  Pl/$2+3  refers  to  page  1,  and  the  3rd  information  block  ■ 
after  the  label  $2.  Similarly,  P2/7,8,9  refers  to  page  2 and  blocks  7 
through  9. 

3.1.2  Discussion 

The  Navigation  Subprogram  is  handled  by  the  Five-Millisecond  Interrupt  Rou- 
tine of  the  Executive  Subprogram,  and  is  separated  into  two  non-f2-tasks : 
Velocity  Processing  (VP)  , and  RIJ  Update  (RU)  . As  part  of  the  non-Sl-task 
table  these  routines  are  called  at  a frequency  of  10/second. 

a)  Velocity  Processing:  This  routine  processes  the  velocity  and  heading 
data  which  is  input  from  either  the  E.M.  Ship's  Log  (velocity)  and  the 
Mark  19  Repeater  (heading) , and/or  the  respective  manual  inputs  from 
the  Control-Indicator.  If  the  data  are  from  the  external  sources,  the 
inputs  will  be  smoothed  before  processing.  This  is  not  necessary  for 
the  manual  inputs . 

The  submarine  velocity  input  is  resolved  into  the  system  axes  (R2  and 


R^)  and  then  corrected  by  velocity  increments  from  the  combinational  filter. 
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b)  RIJ  Update:  The  iterative  updating  of  the  position  matrix  is  performed 
by  converting  the  velocity  over  the  last  iteration  into  the  effective 
angular  rotation  about  each  of  the  system  axes . These  rotations  are 
then  used  to  generate  the  rotation  update  matrix.  The  update  matrix 
is  multiplied  by  the  previous  position  matrix  to  yield  the  change  of 
position.  Periodically  the  Kalman  routine  will  be  generating  positional 
corrections.  These  will  be  added  to  and  processed  with  the  rotations 
generated  from  the  velocity. 


3.1.3  Flow  Diagram  Description 

3. 1.3.1  Velocity  Processing 
Pl/VELOCITY  PROCESSING 

Sets  up  address  of  synchro  data  and  index  to  read  the  synchro  inputs. 


a)  Smoothing: 

pl/VELOCITY  PROCESSING  $1  through  p2/l 

This  loop  reads  and,  if  necessary,  smooths  the  incoming  data  The  first 
input  is  heading.  The  loop  through  $2  is  the  process  of  data  accumulation 

set  Z = (4.^  - 4.^^) 

Test  |Z|  >4.4°  ? 

Yes:  4j.  = 0.02  Z + 4^, 

A Ao 

Continue 

No:  = 4j, 

Ao  ^A 
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The  second  time  through  the  loop,  velocity  is  smoothed. 


Set 


Z = (V  - V ) 
^ TAS  TASo-^ 


Test  |Z|  -■  12.2  knots  ? 


Yes:  V^^3=0.02Z+ 


Continue 


No:  V = V 

TASo  TAS 


b)  Check  Mode: 


p2/2  through  p3/$33 


The  program  must  check  the  velocity/heading  mode  set  by  the  operator 
via  the  Control-Indicator:  if  MAN  Marker  true,  use  manual  velocity 
heading  inputs;  if  VEL  Marker  true,  use  manual  velocity  and  smoothed 
heading;  if  LOG  Marker  true  use  both  smoothed  values  above.  Now 


let  and  = velocity  and  heading  input  from  either  the  output  of 


the  smoothing  routine  or  the  manual  input  (Control -Indicator) . 
c)  Uncorrected  Velocity  Resolution: 


p3/$33  + 1 
Subroutine  RESOLVE 


+A> 


Vat  Cos  (8^  + +a) 


p3/$33  + 2 through  p4/2 

Override  using  Program  Monitor  Unit, 
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d)  Velocity  Corrected: 
p4/$12  through  p4/$14 

If  a new  NAVMODE  is  not  indicated,  then  set: 


V = V + 6V 
C2  2 2 


v„  . V3  + 6V3 


3. 1.3. 2 BIJ  Update 
a)  Rotational  Correction  Terms: 

p5/RIJ  UPDATE  through  p5/RIJ  UPDATE  + 1 


A9„ 


1 + e (1-2  + r332  . ,^^2) 


V At 
C3  NAV 


-2e  ,33  !c2_^  ^ 

o 


A0. 


1 + e (1-2  r^^2  -r3^2  ^ ^^^2^ 


V„.  At  NAV 

"21  'si  -T + 


^C2  '^‘^NAV 


p5/RIJ  UPDATE  +2 
Set  602  = 683  = 0 
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b)  R. . Matrix  Rotation: 
-U 

p5/RIJ  UPDATE  +3 


Subroutine 

ROTATE 

RIJ' 

's 

+ 

-AG2 

2 

H = 

-A93 

AG2  AG3 

A92 

2 

A02  AG^ 

2 

-AG22 

2 

2 

R.  . 

11 

-"new 

R.  . 
^^old 

+ j 

.®]  3x3 

c)  Wander  Azimuth  Angle: 
p5/RIJ  UPDATE  +4 

' r 


9 = TAN 

P 


-1 


21 


•31  J 


Exit 


3.1.4  Description  of  Subroutines  Used  by  the  Navigation  Subprogram 
a)  SMOOTH  (page  6) 

The  subroutine  will  smooth  a noisy  data  input  with  the  last  input. 

As  indicated  in  3.1.3.1~a,  the  new  data  less  the  old  data  is  checked 
to  see  whether  it  is  greater  in  absolute  value  than  4.4°  = 12.2  knots 
(i.e.  on  synchro  input  reference). 

If  so,  then  it  is  smoothed  as  indicated. 

If  not,  then  the  input  data  is  used. 

3.2  FLOW  CHARTS 

The  Navigation  Subprogram  flow  charts  are  presented  on  the  following  pages 


Vol  VIII 


8 


NORT  73-48 


NORTHROP 


Electronics  Division 


1 


1 

i 

PAOC  0001 


• VELOCITY  PAOCesSINO 

• 

• THIS  PROGRAM  READS  AND  CONVERTS  THE  THO  SYNCHRO  INPUTS  (SHIPS  LOO 

• AND  TRUE  HEADING)  INTO  A USABLE  FORM.  IT  COMPUTES  THE  VELOCITY 

• along  the  Ra  AND  R3  AXIS  BASED  ON  THE  NAVAGATION  MODE  SELECTED  DY 

• THE  OPERATOR.  IT  IS  A NON  OMEGA  TASK  THAT  IS  EXECUTED  EVERY 

• TENTH  OF  A SECOND. 
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PAQC  0002 


• THE  OPERATOR  HAS  SELECTED  A NAV  - HOD 

• MODE  THROUGH  A C-|  PANEL  PROCEDURE. 

• THE  PROCEDURE  DICTATES  THAT  ONE  AND 

• ON.V  ONE  MODE  HILL  BE  SELECTED. 
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PAOC 


• LAB  use  ONLY 

• ALLOM  LAB  OPCRATOR  TO  OVeRRIOC 

• VCL/HOC  INPUTS  PROM  THC  PROCRAH 


0003 


voi  vm 
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raum 


PAOC 


• MONITOR  UNIT 


BBK 


0004 
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PACC 


• RIJ  UPDATE 

• this  is  a non  omega  task  that  updates 

• CRAFT  POSITION  10  TIMES  A SECOND 


B8K 


OOOS 
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PACC  0006 

• SYNCHRO  SMOOTHirrC  ROuTirc 

« 

• THIS  PROGRAM  WILL  SMOOTH  TrC  NEW 

• SYNCHRO  INPUT  ir  IT  IS  SUBSTANTI ALLT 

• DIFFERENT  THEN  THE  XO  VALUE 


B8K 
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3.3  COMPUTER  SUBPROGRAM  ENVIRONMENT 

3.3.1  Computer  Subprogram  Tables 
None  . 


3.3.2  Computer  Subprogram  Temporal  Storage 

All  temporary  storage  for  the  Navigation  routine  is  contained  in  the  R15 
pushdown  stack. 


3.3.3  Input /Output  Formats 

DMA  words  through  receive  inputs  from  the  Analog-to-Digital  Con- 

verter. One  word  is  brought  in  during  the  last  one-third  of  each  5-milli- 
second period,  with  all  right  words  cycled  every  40  milliseconds.  DMA  word 
lA  contains  the  true  heading  input  and  word  IB  contains  the  ship's  log 
input.  Each  of  these  inputs  is  from  a synchro  with  either  a tangent  or 
cotangent  in  bits  I to  12  of  the  input  word . These  bits  define  the  synchro 
input  within  a single  octant  (45  degrees)  . Bits  14  to  15  of  the  input  word 
define  the  correct  octant.  The  first  octant  is  0 and  bit  14  true  defines 
the  second  octant.  Bits  1 to  12  represent  a tangent  for  octants  0,3,4,  and 
6;  otherwise  they  contain  a cotangent. 

Word  lA  converts  directly  to  true  heading.  Word  IB  is  shifted  120°  from 
zero  so  that  it  is  necessary  to  subtract  120°  from  the  synchro  value  before 
converting  to  velocity.  The  conversion  factor  is  40  knots  per  360°. 


3.3.4  Required  System  Library  Subroutines 


Subroutine 

Functional 
Description 
(Section  3.1.3) 

Flow 

Diagram 

Subprogram  Design 
Document 

(by  Volume  Number) 

RESOLVE 

(a) 

3/$33  + 1 

XII  Common  Subroutine 

ATAN 

(b) 

60/RlJ  UPDATE  + 

4 

XII  Common  Subroutine 

SIN /COS 

(b) 

60/RIJ  UPDATE  + 

4 

XII  Common  Subroutine 

ROTATE  RIJ's 

(b) 

Page  61 

XII  Common  Subroutine 
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